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Abstract 


Bearing  friction  can  be  accurately  modeled  using  the  Coulomb  friction 
model,  provided  the  bearing  is  running.  In  an  application  where  the  bearing  is 
rotated  only  a  very  small  amount,  the  bearing  does  not  actually  rotate.  Instead, 
the  bearing  undergoes  plastic  deformation.  A  nonlinear  friction  model  was 
developed  by  P.  R.  Dahl  of  the  Aerospace  Corporation  in  the  late  sixties  which 
addresses  this  region  of  placticity  or  compliance  zone.  Two  friction 
compensation  schemes  for  a  single  axis  position  servomechanism  wei developed 
and  compared  in  this,  study.  The  first  compensator  was  an  integral  control 
regulator/estimator  which  used  the  Coulomb  friction  model.  The  second,  more 
complicated  compensator,  was  an  extended  Kalman  filter  (EKF)  design  which 
used  the  Dahl  friction  model.  The  compensator  designs  were  simulated  using 
ProMatlab™.  Comparisons  were  made  of  the  time  response  characteristics  to 
determine  if  any  increases  in  performance  were  worth  the  added  complexity  of 
the  Dahl  model  EKF  controller. 


XI 


COMPARISON  OF  POINTING  CONTROL 
SYSTEMS  UTILIZING  DAHL  AND  COULOMB 
FRICTION  MODEL  COMPENSATION 

1.  Introduction  and  Background 

1.1  Problem  Motivation 

As  technology  increases,  so  does  the  demand  on  control  systems.  New 
weapon  systems,  such  as  those  proposed  under  the  umbrella  of  the  Strategic 
Defense  Initiative,  will  require  servomechanism  pointing  control  to  accuracies 
down  to  the  milli-radian  and  even  micro-radian  level.  Precision  pointing 
control  of  any  gimballed  object  is  hampered  by  many  nonlinear  disturbance 
forces  or  torques.  These  may  include  cogging  torques,  magnetic  drag  torques, 
resistant  forces  caused  by  the  restricted  range  of  motion  of  cables  or  wire 
harnesses,  and  of  course,  the  frictional  torques  caused  by  the  contacting 
surfaces  of  the  bearings.  These  frictional  torques  affect  the  precision  pointing 
capabilities  the  most. 

Since  the  dawn  of  time,  mankind  has  had  to  deal  with  the  good  and  bad 
aspects  of  friction.  If  it  weren’t  for  friction,  our  ancestors  would  not  have 
been  able  to  rub  two  sticks  together  to  make  the  fires  essential  to  their 
survival.  In  fact,  if  it  weren’t  for  friction,  the  simplest  tasks  such  as  walking 
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would  be  impossible  as  we  know  it.  Yet  a  vast  majority  of  the  scientific 
community  will  neglect  the  effects  of  friction  where  at  all  possible,  because  of 
the  added  complexity  involved  when  friction  is  retained.  In  his  doctoral 
dissertation,  Brian  Armstrong  commented  on  something  Leonardo  da  Vinci 
wrote  a  long  time  ago  concerning  the  lack  of  friction  among  the  planets  and 
stars. 

Leonardo  understood  that  the  friction  is  absent  from  the  state  of 
grace.  Thus  friction  is  confined  to  this  mortal  world;  friction  is  a 
consequence  of  original  sin... But  for  all  of  this,  in  the  discussion 
of  dynamics  for  control  of  mechanical  systems  friction  is  but  little 
studied  and  often  omitted.  (1:1) 

Even  when  we  do  address  friction,  we  usually  do  so  in  such  a  simplified, 
cursory  fashion  that  it  often  taints  the  physical  essence  of  the  design  work. 

When  friction  is  accounted  for,  the  question  of  which  friction  model  to 
use  must  still  be  answered.  There  are  several  friction  models  of  varying 
complexity  which  may  offer  the  designer  varying  levels  of  performance  over 
the  entire  spectrum  of  the  friction  regime.  There  also  exists,  within  the  realm 
of  friction,  different  regions  of  interest.  The  physics  of  these  different 
regions  may  vary  substantually,  such  that  they  absolutely  require  different 
models  to  represent  them  accurately. 

Two  friction  models  that  are  of  interest  for  this  thesis  are  the  Coulomb 
friction  model  and  the  Dahl  friction  model.  The  Coulomb,  or  running  friction 
model  as  it  is  often  called,  was  developed  by  Charles  Augustin  Coulomb 
around  the  year  1781.  In  the  simpler  running  friction  model.  Coulomb 
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proposed  the  existance  of  a  constant  force  which  acted  against,  or  with,  the 
external  force  depending  on  the  direction  of  the  velocity.  The  Dahl  model, 
developed  by  P.R.  Dahl  in  1969,  treats  friction  as  a  nonlinear  spring  or  elastic 
region  for  small  deflections  while  for  large  deflections  the  friction  value 
approaches  the  running  or  Coulomb  friction  value.  Both  of  these  will  be 
discussed  in  much  greater  detail  in  Chapter  Two  and  Chapter  Three. 

1.2  Previous  Work 

Tribology,  the  study  of  wear  and  friction,  has  existed  for  many 
hundreds  of  years.  There  has,  however,  only  been  a  moderate  amount  of 
work  done  on  adaptive  friction  compensation,  with  the  majority  in  just  the 
past  five  to  ten  years.  Still,  several  articles  have  been  published  on  this 
particular  topic.  There  are  two  papers  that  relate  closely  to  this  research 
effort.  One  was  written  by  Lewis  C.  Himmel,  et.  al.,  of  The  Aerospace  Co. 
(2:642-643)  and  the  other  was  written  by  Craig  D.  Walrath  of  the 
Westinghouse  Defense  and  Electronics  Center  (3:721-722). 

Both  papers  examine  the  use  of  adaptive  control  techniques  for  friction 
compensation,  and  both  utilize  the  Dahl  friction  model.  The  papers  differ  in 
the  estimation  techniques  for  the  adaptive  control.  Himmel  and  company  used 
a  second  order  difference  scheme  to  estimate  the  friction  acceleration. 

Walrath,  on  the  other  hand,  developed  an  adaptive  filter  which  used  a  scaled 
bilinear  transformation  to  estimate  the  Dahl  friction  parameters.  Block 
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diagrams  for  the  two  schemes  are  shown  in  Figures  1-1  and  1-2. 


Figure  1-1  Mathematical  Model  for  the  Himmell  Friction  Compensator. 
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Figure  1-2  Mathematical  Model  of  the  Walrath  Friction  Compensator. 


1.3  Present  Work 


In  this  research,  friction  compensators  were  designed  for  a  single  axis 
position  servomechanism  using  both  the  Coulomb  friction  model  and  the  more 
complex  Dahl  friction  model.  Two  compensators  were  designed  using  position 
feedback  only.  The  first  design  used  the  Coulomb  friction  model  and 
incorporated  integral  control  action  in  a  regulator/estimator  in  an  attempt  to 
cancel  the  actual  friction  prior  to  entering  the  plant  model.  The  second 
compensation  scheme  used  the  more  complicated  Dahl  friction  model  along 
with  an  Extended  Kalman  Filter  (EKF)  to  provide  adaptive  control  techniques 
in  estimating  the  Dahl  friction  parameters.  This  compensator  design  also 
attempted  to  estimate  and  cancel  the  friction  prior  to  the  plant  process.  These 
designs  were  then  simulated  using  ProMatlab™.  Simulations  were  done  using 
both  large  and  small  magnitude  commanded  inputs.  This  was  to  insure  that 
both  the  elastic  friction  region,  for  small  deflections,  as  well  as  the  running 
friction  region,  for  large  deflections,  were  covered  in  the  investigation.  One 
of  the  main  focal  points  of  this  research  was  to  determine  whether  the 
advantages  of  using  the  Dahl  model  EKF  friction  compensator  outweigh  the 
obvious  disadvantages  in  design  complexity  and  large  onboard  computing 
power  that  is  required. 
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II.  Friction  Theory 


2.1  Coulomb  Friction 

Ordinary,  common,  everyday  friction  can  be  divided  into  two  parts: 
static  friction  and  dynamic  friction.  Static  friction,  or  stiction  as  it  is 
sometimes  called,  refers  to  the  friction  force  of  a  static  system,  which  must  be 
overcome  in  order  for  the  system  to  move.  Dynamic  friction  refers  to  the 
frictional  force  of  the  dynamic  system  once  the  motion  has  begun.  The  force 
required  to  overcome  the  static  friction  force  is  greater  than  the  force 


Figure  2-1  Plot  of  Ideal  Friction  vs  Time 

required  to  keep  it  moving.  Figure  2-1  shows  this  phenomenon  graphically 
(4:251).  A  good  physical  example  (one  that  most  everyone  is  probably 
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familiar  with)  might  be  the  graduating  AFIT  student,  packing  their  belongings 
to  move  on  the  next  challenge.  Inevitably  they  will  pack  all  of  their  text 
books  into  one  big  box.  Because  this  box  is  so  heavy,  the  only  way  to  move 
it  is  to  slide  it  across  the  floor.  The  student  begins  pushing  the  box  but  it 
doesn’t  move.  The  student  pushes  steadily  harder  until  suddenly  the  force 
applied  by  the  student  overcomes  the  stiction  force  and  the  box  begins  to  slide 
across  the  floor.  However,  once  the  box  has  begun  moving,  the  student 
notices  that  a  smaller  force  is  required  to  keep  the  box  moving  at  the  same 
velocity.  The  point  where  the  applied  force  was  equal  to  the  static  friction 
force  is  known  as  the  point  of  impending  motion  or  impending  slippage 
(4:251). 

In  the  year  1781,  Charles  Augustin  Coulomb  conducted  experiments 
with  sliding  blocks.  He  made  three  conclusions  which  are  applicable  at  or 
after  the  point  of  impending  motion.  These  conclusions  are: 

1.  The  total  force  of  friction  that  can  be  developed  is  independent  of 
the  magnitude  of  the  area  of  contact. 

2.  For  low  relative  velocities  between  sliding  objects,  the  frictional 
force  is  practically  independent  of  velocity.  However,  the  sliding 
frictional  force  is  less  than  the  frictional  force  corresponding  to 
impending  slippage. 

3.  The  total  frictional  force  that  can  be  developed  is  proportional  to 
the  normal  force  transmitted  across  the  surface  of  contact.  (4:252) 

Today,  these  conclusions  are  known  as  Coulomb’s  laws  of  friction. 

Furthermore,  because  Coulomb’s  laws  apply  to  the  dynamic  friction  region. 
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Coulomb  friction  is  often  referred  to  as  running  friction. 


2.2  Dahl  Friction 

The  Dahl  friction  model  was  developed  by  P.  R.  Dahl  in  the  late  sixties 
as  a  new  math  model  for  solid  friction.  Over  the  years  it  has  gained 
acceptance  by  the  scientific  and  engineering  community,  mainly  as  a  ball 
bearing  friction  model,  which  fits  in  well  with  this  research. 

Dahl  made  the  observation  that  the  time  rate  of  change  of  solid  friction 
could  be  expressed  as 

dF{x,t)  ^  dF{x)  dx  ^2.1) 

dt  dx  dt 

where  F(x)  is  the  solid  friction  force  as  a  function  of  the  relative 
displacement,  x.  Dahl  claims  that  the  typical  friction  force,  F(x),  is  like  that 
shown  in  Figure  2-2.  Here  you  can  see  that  the  friction  force  monotonically 


f 
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Figure  2-2  Typical  Dahl  Friction  Force  Function 
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approaches  ±Fg,  which  is  the  running  friction  value,  depending  on  the 
direction  of  the  velocity.  For  x  >0,  F(x)  approaches  +Fg  and  for  x  <0, 


F(x)  approaches  -Fg.  Notice  that  in  Figure  2-2  the  friction  function  slope, 

,  remains  positive,  even  when  the  direction  of  the  rate,  x  ,  changes. 

Dahl  experimentally  determined  this  friction  slope  function,  ^  to  be 

dx 

described  by 

^  .  a\i-Lsgni\<  (2, 


where;  a  =  Rest  stiffness  parameter 

F^  =  Coulomb  or  running  friction  parameter 
i  =  Solid  friction  exponent  parameter 

The  Dahl  friction  model,  in  essence,  behaves  like  a  soft  spring  for  small 

deflection,  yet  approaches  the  Coulomb  friction  value  for  large  deflections. 

Physically  what  this  means,  when  applied  to  a  ball  bearing,  is  that  the  bearing 

will  deform  slightly  before  it  begins  to  roll.  If  the  deflection  is  small  enough, 

the  bearing  may  never  roll  at  all— just  experience  plastic  deformation.  This 

region  in  which  the  bearing  deforms  is  the  elastic  region,  which  Dahl  says 

behaves  like  a  nonlinear  spring.  From  this  point  on,  this  elastic  region  will 

be  referred  to  as  the  compliance  zone.  This  compliance  zone  is  essentially 

neglected  by  the  Coulomb  model.  In  using  the  Coulomb  friction  model,  the 

assumption  is  usually  made  that  the  magnitude  of  the  relative  deflection  is 

greater  than  the  compliance  zone,  thereby  Jumping  immediately  to  the  running 
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friction  value. 


The  reader  might  also  have  noticed  that,  according  to  the  Dahl  model 
(see  Figure  2-3),  the  friction  value,  F,  is  never  greater  than  the  running 
friction  value,  F^.  This  is  contrary  to  what  Coulomb  postulated  (recall  Figure 
2-1)  when  he  observed  a  stiction  value  larger  than  the  running  friction  at  the 
point  of  impending  motion.  Dahl  (5:53-56)  and  others  (6:24)  have  conducted 
numerous  experiments  in  this  area  and  have  concluded  that,  for  ball  bearing 
friction  at  least,  the  breakaway  friction  value  is  not  greater  than  the  running 
friction. 

Integrating  equation  2.2  with  respect  to  x  (with  F(0)=0)  yields 

—  =  1 -[1 -(l-/)i.]<^  (2.3) 

Fr  X, 


for  i?J  1,  and 


*  C 


e  '^) 


(2.4) 


for  i  =  1 ,  where 


(2.5) 
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The  force  deflection  loops  (equation  2.3)  for  i=0,  i=‘A,  i  =  'A,  i  =  l, 
and  i=2  are  plotted  in  Figure  2-3  (7:3).  It  should  be  easy  to  see  here  the 
physical  significance  of  x^,.  It  is  the  knee  of  the  force  deflection  curve,  or  the 


F 


Figure  2-3  Force  Deflection  Curves  for  Varying  i 


point  where  the  model  essentially  changes  from  a  nonlinear  elastic  spring  to  a 
more  conventional  Coulomb  friction  model.  Thus,  the  compliance  zone  can  be 
estimated  using  equation  2.5. 
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III.  Compensator  Designs 


3.1  The  Single  Axis  System  and  Assumptions 

3.1.1  The  Single  Axis  System.  As  mentioned  previously,  the  system 
that  was  used  for  this  study  was  a  single  axis  servomechanism  or  gimbal. 
Consider  a  system  like  the  one  shown  in  Figure  3-1  limited  to  a  single  degree 
of  freedom.  For  the  purposes  of  this  study,  it  was  assumed  that  the  motor 
torque  and  rotation  were  in  the  same  direction,  and  the  friction  torque  was 


Figure  3-1  Single  Axis  Servo  Reference  Frame 
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opposing  the  motor  torque.  The  equation  of  motion  for  this  system  is 


(3.1) 


where 


J  =  moment  of  inertia  for  the  system 
=  motor  torque 
Tp  =  friction  torque 


Equation  3.1  can  be  rewritten  as 


S  -  Tf) 


(3.2) 


If  we  neglect  the  friction  and  set  Tp  =  0,  a  state  space  representation  of  the 
system  would  be 


'o' 

0  1 

X  + 

1 

0  0 

J 

3^  =[l  0]x 


where  the  state  and  the  input  are 
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X 


u  = 


A  block  diagram  of  this  simplified  system  is  shown  in  figure  3-2. 


Figure  3-2  Block  Diagram  of  Simplified  Servo 


3.1.2  Assumptions.  Since  we  are  interested  in  the  effects  of 
friction  in  this  study,  Tp  cannot  be  neglected.  Additionally,  for  us  to  design 
and  simulate  controllers  that  cancel  out  the  effects  of  friction,  the  actual 
friction  must  be  known,  or  a  friction  model  must  be  chosen  to  represent  the 
true  friction.  It  has  been  shown  by  Dahl  and  others  that  the  Dahl  model  is  an 
accurate  representation  of  the  actual  bearing  friction  (5:53-60),  (7:24). 
Therefore,  it  was  assumed  here  that  the  Dahl  friction  parameters  a,  i,  and 
(the  running  friction  torque)  were  known  for  the  true  friction.  Using  this  as 
the  truth  model,  compensators  could  then  be  designed  to  cancel  the  friction. 
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A  block  diagram  of  this  general  system  without  the  feedback  controller  is 
shown  in  Figure  3-3.  In  addition,  it  was  assumed  that  the  moment  of  inertia, 
J,  was  known  and  constant  with  time. 


Figure  3-3  System  with  Friction  Truth  ffouci 


Equation  3.4  is  the  state  space  representation  of  the  system  with  the  Dahl 


model  imposed  as  the  true  friction  model. 


0 

1 

0  ' 

'o' 

0 

0 

_1 

X  + 

1 

J 

J 

0 

DF 

0 

0 

(3.4) 


y  =  [l  0  0]x 


where 
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X 


u  =  T 


m 


and 

DF  ^  o\\-  LsgnQy 
*  /• 


which  is  the  Dahl  friction  model. 

3.2  Integral  Action  Regulator/Estimator  with  Coulomb  Friction 

3.2.1  Integral  Action.  It  is  very  desirable  to  have  zero  steady  state 
error  in  a  precision  pointing  application.  To  accomplish  this,  integral  control 
action  was  employed.  Integral  control  was  introduced  by  augmenting  the  state 
vector  with  the  desired  integration,  which  in  this  case  was  the  friction  torque, 
Tp  (8:387).  The  compensator  state  vector  became 

'e  ‘ 

/> 

which  will  work  nicely  with  the  Coulomb  friction  model.  This  will  be  shown 
later. 
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3.2.2  The  Coulomb  Regulator/Estimator.  The  following  sections 
describe  the  technique  used  to  design  the  friction  compensator  using  the 
Coulomb  friction  model  and  regulator  and  estimator  theory. 

3.2.2. 1  State  Space  Representation  with  Integral  Action.  In 
dynamical  systems,  Coulomb  friction  is  often  modelled  as  a  piece-wise  linear 
function  similar  to  that  shown  in  Figure  3-4.  The  friction  value  is 
instantaniously  set  to  positive  running  friction  value  for  positive  velocities  and 
to  negative  running  friction  value  for  negative  velocities.  Intuitively, the 
friction  value  would  then  be  equal  to  zero  for  zero  velocity. 


(-») 

(V) 

-« 

e 

-T, 


Figure  3-4  Coulomb  Friction  Model 

Clearly,  in  this  friction  model,  the  friction  torque  does  not  change  with 
dTr 

velocity  (i.e.  _ L  =  0  )  except  at  the  discontinuity  point,  where  the  velocity 

dv 


3-6 


is  zero.  It  can  also  be  said  that  the  friction  torque  does  not  change  with  time 


since 


dTp  dTp  dY 
~dv  dt 


(3.5) 


and 


This  works  well  given  our  desire  to  implement  integral  action.  By  augmenting 

the  state  vector  with  Tp,  T  p  (which  is  _ L  )  was  required  to  form  the  state 

dt 

space  representation.  The  state  space  equation  for  the  integral  augmented 
system  with  the  Coulomb  friction  model  is  then 

X  =  Ax  +  Bu 


y  =  Cx 


or 


0  1  0  ' 

‘o' 

0  0-1 

X  + 

1 

J 

J 

0  0  0 
u 

0 

(3.6) 
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>  =  [l  0  o]  X 


where 


u 


The  augmented  A  matrix  in  equation  3.6  has  one  complete  row  of  zeroes 
which  represents  a  pole  at  the  origin;  or  a  pure  integrator. 

3. 2. 2. 2  The  Regulator/ Estimator  Problem.  For  the  system 

X  =  Ax  +  Bu 


y  =  Cx 


recall  that  the  Luenberger  estimator  is 

i  =  AJt  *  Bu  *  L(y-CJt) 

where  $  is  the  estimate  of  the  state  and  L  is  the  proportional  estimator  gain 
matrix,  chosen  to  achieve  satisfactory  error  characteristics  (8:345). 
Combining  like  terms  in  equation  3.7  yields 
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jc  =  {A-LQi  +  Bu  +  Ly 


(3.8) 


For  the  regulator,  we  combine  equation  3.8  with  the  control  law 


u  =  'kJt 


(3.9) 


and  assuming  there  is  no  command  input,  we  get 


X  =  {A-LC)Jt  +  Bi-ldt)  +  Ly 


(3.10) 


or 


i  =  (A-Bk-LC)£  +  Ly 


(3.11) 


where  k  is  the  proportional  regulator  gain  marix.  Substituting  y=Cx  into 
equation  3.11,  we  get 


£  =  {A-Bk-LQ£  *  L{Cx) 


(3.12) 


or 


£  =  A£  *  Ba 


(3.13) 


where 
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A  =  A-Bk-LC  ;  B  =  L  and  U  =  Cx 


For  the  servo  model  that  was  generated  earlier,  y=Cx  or 


>>=[10  0] 


=  0 


Therefore,  according  to  equation  3.13,  the  input  to  the  regulator,  u, 
0.  But  that  was  for  a  system  with  no  commanded  input.  However, 
wish  to  perform  a  command  following  task,  we  need  to  difference  0 
command  input,  0^.  Thus,  equation  3.7  becomes 

i  =  AJt  +  Bu  +  L(y-C£-0<.) 


Following  the  same  procedures  as  before  yields 

i  =  (A-Bk-LQi  +  mCx-Q^) 

and  since  Cx  =  0 

i  =  (A-Bk-LQJt  +  L(0-0^) 


should  be 
since  we 
with  a 

(3.7a) 


(3.12a) 


(3.12b) 
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This  effectively  provides  error  feedback  for  command  following  type  systems 
(9).  The  block  diagram  of  the  system  developed  so  far  is  shown  in  Figure 
3-5. 
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Figure  3-5  Coulomb  Friction  Model  Reg/Est  Compensator 
3.2.2. 3  Incorporation  of  the  "True"  Friction.  Combining  the 
results  of  the  last  section  with  the  true  friction  model  assumptions  made  in 
Section  3.1.2  yields  the  system  shown  in  Figure  3-6.  As  was  mentioned  in  the 
introduction,  the  objective  of  the  compensator  is  to  cancel  out  the  friction. 


Figure  3-6  Coulomb  Compensator  with  True  Friction 
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To  accomplish  this,  u,  which  is  -k^,  would  have  to  contain  the  estimate  of 
friction,  .  This  was  accomplished  by  the  following  method.  The 
regulator  gains,  k  =  [ki,k2,k3],  and  the  estimator  gains,  L= [11,12,13]’’'',  were 

determined  by  placing  the  regulator  and  estimator  poles  with  full  state 
feedback  to  get  the  desired  transient  response  and  error  characteristics.  This 
was  done  using  the  Place  command  in  ProMatlab”,  which  uses  a  technique 
described  in  a  report  by  Kautsky  and  Nichols  on  robust  eigen  structure 


assignment  in  state  feedback  control  (10).  The  regulator  poles  were  only 


placed  for  the  2-state  plant,  — -  .  This  gave  values  for  kj  and  k2,  but  since 

J  S 

the  goal  was  to  try  to  cancel  friction,  k3  is  set  to  -1.  Thus, 


or 

u  =  -  k2^  +  tf 


The  entire  state  space  equation  is  then 


(3.14) 
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(3.15) 


0 

0 

1 

0 

'g' 

0 

0 

0 

0 

_  1 

0 

+ 

1 

J 

j 

0 

DF 

0 

Tp 

-itiG 


-  k.Q  +  Tr 


From  equation  3.15,  we  can  extract  0,  which  is 


it,e 


(3.16) 


It  should  be  easy  to  see  from  equation  3.16  that  with  a  good  job  of  estimating 
the  friction  torque  (i.e.  Tp  »  fp  )  the  compensator  should  cancel  out  the 
true  friction  torque  resulting  in  a  seemingly  frictionless  system.  This  should 

give  better  response  characteristics  for  both  large  and  small  deflections. 

Notice  also,  that  in  Figure  3-6,  sensor  noise  (v)  can  inserted  into  the 

system  model. 

3.3  Extended  Kalman  Filter  with  Dahl  Friction  Model 

This  section  covers  the  development  of  the  extended  Kalman  filter 
friction  compensator.  The  basic  theory  of  the  extended  Kalman  filter  is 
discussed  first,  followed  by  the  specific  application  to  this  problem. 

3.3.1  Extended  Kalman  Filter  Theory.  The  extended  Kalman  filter 
(EKF)  is  used  in  nonlinear  system  applications  where  the  linearized  filter 
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breaks  down.  The  basic  principle  of  the  EKF  is  to  relinearize  about  each 
estimate  of  the  state,  after  it  is  computed.  After  each  consecutive  time 
step,  tj'*',  the  state  vector,  x(ti^)  is  recomputed  and  a  new  estimate  of  the  state 
trajectory  is  made  (11:42).  This  assumes  that  the  step  size  is  sufficiently 
small  such  that  the  linearization  is  a  good  approximation  of  the  nonlinear  state 
equation. 

In  general,  the  state  space  equations  are 


X  =  Ax,u,0  +  G(()w(f) 
z  =  h{x,t)  +  v(0 


(3.17) 


where  x  is  the  slat  vector 

f(x,u.t>  is  some  nonlinear  function  of  x(t),  u(t),  and  t 
z  is  the  measurement  which  may  be  a  nonlinear  function  of  x  and  t 
v,w  are  uncorrelated,  zero-mean,  white  gaussian  noise  vectors 
with  E{w(t)w'‘'(t-T)}=Q(t)5(t-T)  and  E{v(t)v''’(t-7)}  =R(t)5(t-7) 

The  EKF  updates  the  measurement,  Zj,  through  the  folowing  equations 

K{t,)  =  +  i?(,.))"' 

i(r/)  =  i(/,-)  ^  K(r,.)(z(/,)  -  «[%-),/,! 

P{t;)  =  P{t-)  -  K(r,)4,;i(0')Kl 


(3.18) 

(3.19) 

(3.20) 
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where 


The  estimate  is  propagated  forward  in  time  to  the  next  sample  tj+j  by 
integrating  the  following  equations  from  time  tj  to  tj+j; 


(3.21) 


(11:44-45). 

3.3.2  EKF  Applied  to  the  Single  Axis  Servo.  Recall  the  Dahl  friction 

model 

tp  =  DFe 
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where 


DF  ^  a  \\-  LsgnQY 


In  order  for  the  friction  to  be  estimated  we  must  also  estimate  the  Dahl 
friction  parameters,  a,  i,  and  T^.  It  will  be  assumed  here  that  the  running 
friction  value,  T^.,  can  be  measured  a  priori  and  only  a  and  i  need  to  be 
estimated.  Therfore,  a  and  i  were  added  to  the  state.  Thus, 


X  = 


6 

0 

Tf 

a 

i 


(3.23) 


Since  o  and  i  are  constants,  their  time  derivatives  are  equal  to  zero. 
Therefore,  the  state  space  equation  becomes 


JC  = 


- 

0 

0 

ji.u  -  Tfd 

0 

Tf 

a 

= 

ffj^l  -  .^jgn0j  0 

i 

0 

0 

(3.24) 
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=  Ax  =  [l  0  0  0  O] 


e 

e 

Tf 

a 

i 


Solving  for  the  Jacobian,  F[t;x],  we  get 


where 


^  ^  JL  M  M 

dx  dO  ae  dTp  da  dt 
_ 


M. 

de 


o' 

0 

0 

0 

0 


1 

0 

Tf 

—  sgnQ 

^  c 
0 
0 
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0 


1 

1 


a  i 


0 

0 


sgn  0 

‘  C 


0 

0 


e 


0 

0 


0 

0 


^  - 
di 


a 


ein 


0 

0 


Similarly, 


dh  dh  dh  dh  dh 
50  50  dTp  da  di 


or 
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//  =  [l  0  0  0  o] 


for  this  problem. 

Now  we  can  combine  the  results  from  the  previous  sections  concerning 
the  EKF  Dahl  compensator.  The  complete  system  is  shown  in  figure  3-7. 


Figure  3-7  Single  Axis  System  with  EKF  Compensator 

As  was  the  case  with  the  Coulomb  model  regulator/estimator,  we  are 
introducing  an  estimate  of  the  state,  $.  This  state  estimate  contains  an 
estimate  of  the  friction  value,  ,  which  is  summed  with  the  actual  friction, 

Tp  ,  prior  to  entering  the  plant  process.  Here  a  iain,  it  should  be  clear  to 
see  that  if  we  do  a  good  job  estimating  tp  >  it  will  cancel  the  actual  friction 
and  the  system  will  act  as  thought  it  were  frictionless. 


3-19 


One  particular  subtlety  that  has  not  been  discussed  is  the  proportional 
gain  matrix  M  that  pre-multiplies  the  commanded  input,  Ug  or  0g.  This  is 
done  for  a  command  following  system  to  insure  that  the  steady  state  solution 
is  equal  to  the  input  or  =  Gg.  M  is  calculated  in  the  following  manner. 
The  system  under  consideration  is 

X  =  Ax  +  Bu 
y  =  Cx 

u  =  -kx  +  My^ 


where,  for  this  example,  y  =  G  and  yg  =  Gg.  In  the  steady  state,  k-*\  and 
X  -*0.  Thus  we  get 

0  =Ax„^  Bu,,  (3.25) 

yss  =  <3.26) 

=  -^ss  ^  ^yc  <3-27) 


Solving  equations  3.25  through  3.27  for  y,,  yields 
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=  C[Bk-  A]-^BMy^ 


(3.28) 


Requiring  that  yss=yc>  can  solve  directly  for  M  which  is 

M  =  [c[Bk  -  ^ 

3.4  Simulation  of  the  Compensator  Designs 

The  following  section  discusses  the  manner  in  which  the  single  axis 
servo  system  was  dynamically  simulated  with  each  friction  model 
compensator.  Both  compensators  were  simulated  using  ProMatlab™  on  the 
AFIT  Vax  mainframe  computer  known  as  Hercules.  ProMatlab™  is  a  matrix 
manipulation  and  control  system  design  software  package  developed  by 
Mathworks.  It  is  assumed  that  the  reader  has  some  working  knowledge  of 
these  types  of  programs.  Therefore,  the  exact  workings  of  ProMatlab™  will 
not  be  discussed  in  this  thesis  except  where  required  to  adequately  explain  the 
procedure  or  results. 

3.4.1  Coulomb  Model  Compensator  Simulation.  The  single  axis 
system  with  a  Coulomb  friction  model  compensator  developed  in  section  3.2 
(see  Figure  3-6)  was  coded  into  two  ProMatlab™  macros  or  m-files.  The  exact 
code  for  the  two  macros  {Coulomb l.m  and  Coulomb2.m)  that  was  used  for 
these  simulations  is  shown  in  Appendix  A. 


i 

[ 


1 
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3.4. 1.1  Coulombl.m.  The  logic  of  the  first  macro, 


Coulombl.m,  closely  parallels  the  development  in  Section  3.2.2.  As 
mentioned  previously  in  that  section,  the  regulator  and  estimator  gains,  k  and 
L  must  be  available  in  the  variable  list  for  Coulombl.m  to  use.  The  following 
is  the  basic  logic  of  the  macro.  Coulombl.m  takes  the  gains  k  and  L  and 
calculates  the  closed-loop  regulator/estimator  compensator  state  space  A  and  B 
matrices.  These  are  then  discretized  using  the  ProMatlab™  C2D  (continuous 
to  discrete)  command.  The  technique  used  in  ProMatlab™  to  discretize  these 
matrices  is 


where  A^  and  are  the  discretized  state  space  A  and  B  matrices  and 


^d 


Bd- 


As  Coulombl .m  steps  through  for  each  value  of  the  commanded  input,  u^, 
which  is  essentialy  each  time  step  of  0.01  seconds,  the  true  friction  state 
representation  is  calculated  and  discretized.  This  is,  however,  after  the 
previous  time  step  estimate  of  the  friction  has  been  added  to  the  input,  u, 
through  u  =  -kli|j. 


3.4. 1.2  Coulombl.m.  The  second  macro  that  was  used  to 


simulate  the  Coulomb  model  compensator  is  identical  to  Coulombl.m  except 
that  is  uses  a  discrete  time  step  of  0.001  seconds  instead  of  0.01  seconds. 

This  was  done  to  allow  the  use  of  very  fast  estimator  poles  for  comparison 
purposes.  Because  of  the  number  of  points  required  to  get  a  reasonable 
simulation,  this  version  ran  very  slowly.  It  was  only  used  when  it  was 
suspected  that  the  estimator  pole  placement  exceeded  the  Nyquist  sampling 
frequency  of  the  simulation. 

3.4.2  Dahl  Model  Compensator  Simulation.  The  Dahl  model  friction 
compensator  was  coded  into  ProMatlab™  in  much  the  same  manner  as  the 
Coulomb  model  compensator  was,  only  using  the  development  described  in 
Section  3.3.  The  exact  code  for  the  Dahl  model  compensator  simulations  was 
called  Extendkf.m  a»'d  is  given  in  Appendix  B. 

The  first  five  lines  of  the  macro  set  up  the  initial  value  of  the  actual 
state  vector,  used  for  the  truth  model,  and  input  an  initial  guess  for  the 
estimated  state,  SL,  as  well  as  setting  up  a  counter  and  initializing  the  output 
format.  The  macro  then  steps  through  each  time  step  and  value  of  the 
commanded  input,  u^  or  6^.  The  first  time  through,  the  macro  uses  the  initial 
guess  of  a  to  propogate  the  true  state  forward  one  time  step.  Subsequent  time 
steps  use  the  It  that  is  generated  by  the  extended  Kalman  filter  that  was 
discussed  in  Section  3.3. 
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It  should  be  mentioned  here  that,  numerically,  the  actual  Dahl  friction 
value  and  the  estimated  friction  value  may  exceed  the  running  friction  value, 
Tg,  which  we  know  can’t  happen.  Thus,  the  macro  conducts  a  check  to  see  if 
this  occurs.  If  it  does  occur,  the  value  of  the  friction  torque  or  estimated 
friction  torque  is  forcibly  set  to  be  equal  to  the  running  friction  torque,  which 
is  essentially  the  Coulomb  model.  Physically,  this  would  represent  a  large 
deflection  of  the  system,  passing  through  the  Dahl  friction  compliance  zone 
(Xg)  which  was  discussed  in  Chapter  2.  In  some  sense,  then,  the  Dahl 
controller  is  a  hybrid  controller.  When  0g  *  Xg,  the  Dahl  friction  model 
prevails  and  when  0g  >  >  Xg,  the  Coulomb  model  prevails. 
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IVt  Results 


This  chapter  contains  a  discussion  of  the  simulations  that  were 
conducted  with  both  the  Coulomb  model  and  the  Dahl  model  friction 
compensators.  The  response  characteristics  for  each  compensator  and  for 
various  input  commands  were  compared,  and  conclusions  were  made 
concerning  the  advantages/disadvantages  of  each  compensator.  These 
conclusions,  along  with  some  recommendations  are  discussed  in  Chapter  S. 

The  conclusions  that  are  of  particular  importance  are  the  ones  concerning  the 
Dahl  controller  results  for  small  deflection  inputs.  As  was  mentioned  in  the 
intoduction,  the  focus  of  the  research  was  investigate  if  any  advantages  gained 
in  the  use  of  the  Dahl  compensator  outweigh  the  added  complexity  and 
increase  in  onboard  computing  power  required  for  the  extended  Kalman  Filter. 

4.1  Siroulation  Ground  Rules  and  Assumptions 

The  main  assumptions  made  in  the  simulation  of  the  friction 
compensators  concerned  the  system  itself  (i.e.  moment  of  inertia,  Dahl  true 
friction  parameters,  etc.),  design  specification  goals  (i.e.  overshoot,  settling 
time,  max  motor  torque,  etc.),  and  the  commanded  input  characteristics  (DJ. 

4. 1. 1  System  Assumptions.  In  order  to  add  credibility  to  the 
simulations,  a  realistic  baseline  system  was  used.  The  specific  system 
parameters  such  as  a,  i,  T^,  and  J  were  taken  from  actual  experimental  runs 
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by  Dahl  (6:60).  The  following  values  for  the  system  parameters  were  used  for 
all  of  the  simulations:  tr=5.9  ounces/degree,  i  =  1.44,  J=0.6676  inch- 
ounce/degree/second^,  and  T,.=  1.78  inch-ounces.  The  deflection  was  in 
degrees.  The  measurement  noise,  v,  was  a  randomly  generated  input  with 
zero  mean  and  an  assumed  rms  magnitude  of  10  percent  of  the  smallest 
commanded  input  deflections. 

4.1.2  Design  Specification  Goals.  For  these  simulations,  time 
response  specifications  of  overshoot  and  settling  time  were  arbitrarily  set.  For 
a  simulation  to  be  considered  good,  it  must  meet  these  specification  goals. 

The  maximum  allowable  overshoot  was  10  percent  of  the  overall  step  input. 
The  maximum  settling  time  was  four  seconds,  where  settling  time  was  defined 
as  the  time  until  the  response  has  settled  to  within  ±  two  percent  of  its  steady 
state  value.  No  exact  maximum  or  minimum  rates,  accelerations,  or  motor 
touques  were  specified.  However,  these  were  all  taken  into  account  and 
checked  to  make  sure  they  were  realistic  values. 

4.1.3  Commanded  Input  Characteristics.  The  commanded  input  used 
for  the  Coulomb  compensator  simulations  was  a  basic  step  input  like  the  one 
shown  in  Figure  4-1.  The  magnitude  of  the  step  varied  depending  on  whether 
or  not  the  bearing  was  to  be  simulated  inside  of  the  compliance  zone,  x^.  To 
choose  the  magnitude  of  the  step  input,  the  knee  of  the  Dahl  true  friction 
model  deflection  curve  or  compliance  zone  was  calculated  using  the  fact  that 
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Figure  4-1.  Coulomb  Controller  Step  Input 


the  known  rest  slope,  a,  is  just  the  rise  (T,,)  over  the  run  (x^),  or 


For  this  system  with  the  assumed  parameters  x^»0.3  degrees.  Thus,  the 
commanded  step  inputs  for  simulations  inside  the  compliance  zone  are  on  the 
order  of  0.25  degrees,  while  those  for  simulations  outside  the  compliance  zone 
are  on  the  order  of  30  degrees. 

The  commanded  inputs  used  in  the  Dahl  model  compensator  were 
slightly  more  complex  than  those  used  for  the  Coulomb  compensator.  A 
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combination  square  wave  and  step  input  similar  to  that  shown  in  Figure  4-2 
was  used.  The  reason  for  this  was  to  cycle  the  extended  Kalman  filter  through 
a  period  or  two  of  a  square  wave  to  allow  the  estimations  of  the  Dahl  friction 
parameters  to  converge.  Following  the  square  wave  the  system  was  hit  with  a 
constant  step  as  in  the  Coulomb  simulations.  Since  the  system  parameters 
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Figur  4-2.  Dahl  Controller  Input 

were  the  same  for  both  compensators,  the  compliance  zone  is  also  the  same, 
Xc*0.3  degrees.  Thus,  the  magnitude  of  the  Dahl  compensator  simulation 
inputs  were  similar  to  those  for  the  Coulomb  compensator  simulations. 

Since  most  of  the  simulations  were  run  with  a  relatively  large  time  step 
of  0.01  seconds  to  minimize  simulation  time,  the  smallest  magnitude  of  the 
commanded  inputs  for  the  small  deflection  simulations  was  0.25  degrees.  In 
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using  deflections  much  smaller  than  that,  the  simulation  could  be  susceptible 
to  errors  caused  by  the  numerical  integration  with  the  relatively  large  time 
step. 


4.2  Simulation  Results 

This  section  describes  the  speciHc  procedures  and  results  of  each 
simulation  made  using  both  the  Coulomb  compensator  and  the  Dahl 
compensator. 

4.2.1  Coulomb  Model  Compensator  Results.  The  basic 
procedure  used  to  simulate  the  Coulomb  friction  compensator  was  as  follows. 
Regulator  and  estimator  gains,  k  and  L,  were  found  using  the  Place  command 
in  ProMatlab™  as  mentioned  in  chapter  3.  The  regulator  and  estimator  poles 
were  arbitrarily  placed,  keeping  in  mind  that  the  frequency  of  the 
regulator/estimator  poles  should  be  less  than  one  tenth  (0.10)  of  the  frequency 
of  numerical  integration  time  step.  Using  this  initial  pole  placement,  the 
macro  was  run  and  the  deflection  time  response  was  plotted  to  see  if  the 
specification  goals  were  met.  If  not,  the  estimator  and/or  regulator  poles  were 
moved  to  change  their  frequency  and  damping  characteristics,  and  new  gains, 
k  and  L  were  generated.  The  macro  was  run  again  and  the  deflection  time 
response  checked.  This  procedure  was  repeated  until  acceptable  time 
responses  were  achieved.  Other  parameters  besides  time  responses  of  the 
deflections  were  also  checked.  Convergence  of  the  estimate  to  the  actual  state 
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and  rate  response  was  examined.  This  was  done  for  both  large  and  small 
magnitude  commanded  input  deflections.  It  was  also  done  for  simulations 
with  and  without  noise. 

Once  good  values  of  k  and  L  were  found  for  both  large  and  small 
deflection  inputs,  these  gain  values  were  run  on  the  other  input.  For  example, 
if  ksmaii  and  were  the  regulator  and  estimator  gains  that  worked  for  the 

small  deflection,  they  were  then  used  to  run  a  simulation  with  a  large 
deflection  and  vice  versa.  This  was  done  to  assess  the  robustness  of  the 
system.  If  the  controller  did  not  perform  well  for  both  the  large  deflection 
and  the  small  deflection  inputs  using  the  same  gains,  it  can  probably  be 
assumed  that  some  sort  of  gain  scheduling  must  be  employed.  This  is  a  factor 
to  consider  when  comparing  comensator  designs. 

4. 2. 1.1  Coulomb  Large  Deflection  Results.  The  first  Coulomb 
compensator  runs  were  made  without  noise.  Since  the  integration  time  step 
for  Coulombl.m  was  0.01  seconds,  which  has  a  frequency  of  200x  rads/sec, 
the  estimator  poles  can  be  chosen  with  a  frequency  as  high  as  20t  rads/sec. 

As  an  initial  starting  point,  the  estimator  poles  were  chosen  at  s=-10,  -10, 
and  -10.  The  regulator  poles  were  initially  chosen  to  be  s=-0.5±0.5j.  This 
produced  the  following  set  of  gains:  k  =  [0.3338  0.6676  -1]  and  L=[30  300 
-667.58]^.  The  time  response  of  the  position  for  these  gain  values  is  shown  in 
Figure  4-3. 
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Figure  4-3  Coulomb  Large  Input  Initial  Try 


After  a  few  iterations,  the  estimator  poles  were  placed  at  s=-60±2j  and 
(s+60)  and  the  regulator  poles  were  placed  at  s=-0.5±1.5j)]  yielding  gains  of 
k  =  [1.6690  0.6676  -1]  and  L  =  [180  10,804  -144, 375. Sf.  The  resulting 
deflection  time  response  is  shown  in  Figure  4-4.  This  still  did  not  meet  the 
spec  requirement  for  overshoot.  In  order  to  meet  this  requirement,  the 
estimator  poles  had  to  be  put  at  way  out  a  (s-1-75),  (s+75),  and  (s+75),  which 
is  beyond  the  bandwidth  of  the  contoller.  Thus,  the  other  simulation  macro, 
Coulomb2.m  had  to  be  used.  The  regulator  poles  for  this  simulation  were 
placed  at  [s+(.75+ 1.75j)]  and[s-t-(.75-1.75j)].  Figure  4-5  shows  the  0 
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response  using  these  very  high  estimator  poles.  The  estimates  of  position, 
rate,  and  friction  torque  were  plotted  with  the  actual  state  to  check  for 
convergence  of  the  estimate.  These  are  plotted  in  Figures  4-5a,  4-5b,  and 
4-5c.  It  would  appear  that  the  estimate  converges  very  nicely  except  for  the 
position.  This  is  because  the  commanded  input,  6^.  was  added  in  the 
Luenberger  estimator  in  Chapter  3.  This  has  also  been  demonstated  by  Liebst 
(9). 
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Figure  4-4  Coulomb l.m  with  Large  Input  —  Pushing  the  Bandwidth  of 
the  Controller 
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Figure  4-5  Simulation  with  Very  Fast  Estimator  Poles  Run 
Using  Coulomb2.m 
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Figure  4-5a  Actual  and  Estimated  Position 
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Figure  4-5b  Actual  and  Estimated  Rate 


Figure  4-5c  Actual  and  Estimated  Tp 
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4.2. 1.2  Coulomb  Small  Deflection  Results.  The  same  basic 
procedure  that  was  used  with  the  large  deflection  simulations  was  also  used 
with  the  small  deflection  simulations.  For  brevity,  the  initial  pole  placement 
trials  will  not  be  discussed.  Figure  4-6  shows  the  position  time  response  for  a 
small  deflection  with  the  estimator  poles  at  s=-12±2j  and  s=-12  and  the 
regulator  poles  at  s=-0.5±,1.5j,  which  yields  gains  of  k=[1.6690  0.6676  -1] 
and  L  =  [360  436  -1185.6]^.  Here  again,  the  estimate  of  the  state  was  checked 
for  convergence  in  Figures  4-6a,  4-6b,  and  4-6c. 
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Figure  4-6  Coulomb  Small  Deflection  Input 
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Figure  4-6a  Actual  and  Estimated  Position 
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Figure4-6b  Actual  and  Estimated  Rate 
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Figure  4-6c  Actual  and  Estimated  Tp 

4.2. 1.3  Coulomb  Results  with  Noise.  The  previous 
compensators  were  run  again,  only  this  time  a  randomly  generated,  zero-mean 
noise  with  a  rms  magnitude  of  10  percent  of  the  small  step  input  was  added  to 
the  measurement.  The  position  time  responses  are  shown  in  Figures  4-7  and 
4-8  for  both  the  large  and  small  step  inputs.  Clearly,  since  the  noise  is 
relatively  large  compared  to  the  small  deflection  input,  it  has  a  greater  effect 
on  the  time  response.  Still,  the  mean  response  follows  the  same  general  shape 
as  the  ones  without  the  measurement  noise.  Figures  4-7a  through  4-7c  and 
4'8a  through  4-8c  show  the  actual  and  estimated  states  for  both  of  these 
simulations  with  noise. 
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Figure  4-8  Coulomb  Small  Input  with  Noise 


Figure  4-8a  Actual  and  Estimated  Position 
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Figure  4-8b  Actual  and  Estimated  Rate 
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Figure  4-8c  Actual  and  Estimated  Tp 
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4. 2. 1.4  Coulomb  Simulation  Robustness  Check,  As  a  form  of 


robustness  check,  regulator  and  estimator  gain  values  were  run  with  the  other 
commanded  input.  This  was  done  to  see  if  the  compensator  could  handle  large 
variations  in  gains  and  still  meet  performance  requirements.  Figure  4-9  shows 
the  position  time  response  for  small  deflection  gains  run  with  a  large 
deflection  input.  Figure  4-10  showa  the  position  time  response  of  the  large 
gains  run  with  a  small  deflection  input. 
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Figure  4-9  Position  Response  for  Large  Deflection  Input 
Using  Small  Deflection  Gains 
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Figure  4-10  Position  Response  for  Small  Deflection  Input 
Using  Large  Deflection  Gains 

4.2.2  Dahl  Model  Compensator  Results.  The  Dahl  model 
friction  compensator  simulations  were  run  in  a  manner  similar  to  the  Coulomb 
simulations.  One  major  difference  was  that  the  Dahl  compensator  did  not 
need  to  be  given  estimator  gains,  L.  These  were  calculated  internally  in  the 
extended  Kalman  filter,  and  are  time  varying.  Thus,  only  the  regulator  poles 
were  placed  and  regulator  gains  calculated  for  this  compensator. 

There  was  also,  however,  the  very  difficult  task  of  determining  all  of 
the  weights  that  the  extended  Kalman  filter  uses  in  its  estimation  propagation. 
These  include  R,  Q,  and  G  and  were  discussed  in  Chapter  3.  To  find  these 
weights,  numerous  simulations  of  the  extended  Kalman  filter  were  made  in 
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both  open  and  closed  loop  configurations.  By  individually  changing  the 
weights  and  observing  the  effect  each  has  on  the  system,  ranges  of  the  weight 
values  were  determined.  The  system  was  very  sensitive  to  these  weight 
values.  This  sensitivity  will  be  discussed  throughout  the  remainder  of  this 
thesis  in  more  detail. 

4. 2. 2.1  Dahl  Large  Deflection  Results.  The  Dahl  compensator 
simulations  were  also  run  without  noise  at  first.  The  procedure  was  very 
similar  to  that  of  the  Coulomb  simulations.  An  initial  run  was  made  and  the 
position  time  response  was  looked  at.  Changes  were  made  to  the  regulator 
pole  placement  to  change  the  regulator  gains,  k,  along  with  changes  to  the 
weights  Q,  and  R,  to  get  the  desired  response  characteristics.  Figure  4-11 
shows  the  position  time  response  to  a  large  deflection  commanded  input  with 
the  regulator  poles  placed  at  s  =  -3±0.5j  which  produces  a  gain  of  k  =  [6.1 751 
4.0055  -1].  The  weights  used  in  this  particular  run  were 


Q  = 


0  0  0  0  o' 

0  10  0  0  0 

0  0  0  0  0 

0  0  0  30  0 

0  0  0  0  40 


R  =  1 


G  =  7 


Plots  of  the  actual  and  estimated  state  were  made  to  check  for  convergence, 
just  as  with  the  Coulomb  simulations.  These  are  shown  in  Figures  4-1  la 
through  4-1  Ic.  It  would  appear  from  these  plots  that  the  extended  Kalman 
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Figure  4-11  Dahl  Large  Deflection  Input 


Figure  4-1  la  Actual  and  Estimated  Position 
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Figure  4-1  lb  Actual  and  Estimated  Rate 
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filter  is  doing  an  excellent  job  of  estimating  the  states.  This  is  due  to  the  fact 
that  the  system  is  not  in  the  compliance  zone  for  very  long.  Thus,  the  system 
is  spending  most  of  the  time  at  the  running  friction  value,  which  is  known, 
and  the  estimator  does  not  have  to  work  very  hard  to  get  a  good  estimation. 
Subsequent  runs  for  the  large  deflection  inputs  were  made  with  commanded 
inputs  that  excited  the  system  with  a  series  of  small  square  waves  that  were 
within  the  compliance  zone.  The  time  responses  for  these  simulations  were 
very  similar  to  those  shown  previously.  Unlike  the  Coulomb  controller,  the 
Dahl  compensator  does  not  experience  the  quasi-estimation  of  the  position 
state,  0,  due  to  the  incorporation  of  the  commanded  input,  6^. 

4. 2. 2. 2  Dahl  Small  Deflection  Results.  The  same  procedure 
that  was  used  for  the  large  deflection  input  was  also  used  for  the  small 
deflection  input.  The  final  values  chosen  for  the  weights  were 

0  0  0  0  O' 

0  .01  0  0  0 

e=00000  ;  R  =  \  ;  G  =  I 

0  0  0  25  0 

0  0  0  0  30 

The  regulator  poles  were  placed  in  the  same  location  as  before  so  that 
k  =  [6. 1751  4.0055  -1].  The  time  response  of  0  is  shown  in  Figure  4-12.  The 
actual  and  estimated  state  variables  are  plotted  in  Figures  4- 12a  through 
4- 12c.  Here  again,  the  estimate  converges  very  quickly  to  the  actual  values. 
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Figure  4-12a  Actual  and  Estimated  Position 
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Figure  4-12b  Actual  and  Estimated  Rate 


Figure  4-12c  Actual  and  Estimated  Tp 
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4. 2. 2. 3  Dahl  Results  with  Noise.  Both  Dahl  compensators  from 
the  last  two  sections  were  run  with  a  measurement  noise.  The  noise,  v,  was 
identical  to  that  used  in  the  Coulomb  simulations.  The  position  response  for 
the  large  input  is  plotted  in  Figure  4-13  and  for  the  small  input  in  Figure 
4-14.  Contrasting  to  the  Coulomb  noise  simulations,  the  Dahl  compensator 
does  not  seem  to  be  effected  by  noise  very  much  at  all.  The  estimates  of 
position,  rate,  and  friction  torque  are  plotted  with  the  actual  values  in  Figures 
4- 13a  through  4- 13c  for  the  large  deflection  and  in  Figures  4- 14a  through 
4- 14c  for  the  small  deflection.  Here  we  can  see  that  the  noise  does  not  seem 
to  effect  the  estimation  convergence  as  much  as  it  did  in  the  Coulomb 
simulations,  especially  in  the  estimation  of  friction  torque,  Tp.  For  the  most 
part  this  is  true;  however,  from  Figure  4- 13c  it  is  possible  that  the  estimate  of 
Tp  is  not  converging  to  the  actual  value.  Upon  inspection  of  a  and  i,  it  was 
found  that  the  estimate  of  a  and  i  were  not  converging  smoothly  towards  the 
actual  values.  It  is  suspected  that  this  is  caused  by  the  sensitive  nature  of  the 
weights  Q  and  R.  Since  the  system  was  not  acting  within  the  compliance  zone 
for  most  of  the  simulation,  additional  runs  were  made  where  the  system  was 
cycled  through  a  series  of  squa^’e  waves  within  the  compliance  region  to  allow 
the  Dahl  parameters  to  converge  before  hitting  it  with  the  large  deflection 
step.  The  position  and  friction  torque  responses  for  this  simulation  are  shown 
in  Figures  4- 13d  and  4-13e. 
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Figure  4-13  Dahl  Large  Deflection  with  Noise 
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Figure  4-13a  Actual  and  Estimated  Position 
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Figure  4-13b  Actual  and  Estimated  Rate 
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Figure  4-13c  Actual  and  Estimated  Tp 
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Friction  Torque  (Inch-oz)  Position  (dej) 
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Figure  4-13d  Excitation  Prior  to  Large  Deflection  Input 
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Figure  4-13e  Actual  and  Esimated  Friction  Torque 
for  Excitation  of  System  Prior  to  Input 
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figure  4-14  Dahl  Small  Defection  with  Noise 
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figure  4-14a  Actual  and  Estimated  Position 
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Figure  4-14b  Actual  and  Estimated  Rate 


Figure  4-14c  Actual  and  Estimated  Tp 
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4.2.2.4  Dahl  Simulation  Robustness  Check.  Like  the  Coulomb 


compensator,  a  robustness  check  was  conducted  on  the  Dahl  model 
compensator.  As  with  the  Coulomb  controller,  the  gain  and  weight  values 
developed  for  the  large  deflection  inputs  were  run  with  a  small  deflection 
input  and  vice  versa.  Figure  4-15  shows  the  position  time  response  for  a 
small  deflection  input  using  the  regulator  gains  and  weights  used  for  the  large 
deflection  simulation  earlier.  Clearly,  the  6  response  is  within  the 


Time  (sec) 


Figure  4-15  Position  Response  for  Small  Deflection  Input 
Using  Large  Deflection  Gains  snd  Weights 
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specification  limits.  Figures  4-15a  through  4-15c  also  show  that  the  estimate 
seems  to  be  converging  to  the  actual  values.  For  this  system,  regulator  gains, 
weightings,  and  set  of  input  deflections,  the  Dahl  controller  is  robust  enough 
to  handle  both  commanded  input  deflections. 


Time  (see) 

Figure  4-15a  Actual  and  Estimated  Position 
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Figure  4-15b  Actual  and  Estimated  Rate 
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Figure  4-15c  Actual  and  Estimated  Tp 
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However,  in  the  opposite  case,  where  the  small  deHection  gains  and 
weights  were  run  with  the  large  deHection  input,  the  simulation  diverged. 

The  weights  were  such  that  the  estimation  of  a  and  i  were  divergent,  causing 
the  estimate  to  blow  up.  This  is  another  example  of  the  sensitivity  of  the 
weights  Q  and  R,  since,  in  other  simulations,  identical  weights  did  run  fine 
with  both  large  and  small  deflection  inputs,  but  the  performance  requirements 
were  not  met  quite  as  well  or  noise  rejection  characteristics  were  not  as  good. 
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V.  Conclusions  and  Recommendations 


5.1  Conclusions 

Using  the  data  presented  in  Section  4.2,  along  with  observations  made 
from  the  numerous  simulations  not  shown  in  this  thesis,  some  conclusions  can 
be  drawn  as  to  how  these  two  compensators  compare  to  each  other.  Some  of 
the  factors  that  were  looked  at  in  this  comparison  were:  performance  in 
meeting  the  specification  goals,  measurement  noise  rejection  properties, 
computing  power  required,  maximum  motor  torques,  maximum  gimbal  rates, 
and  robustness  to  the  size  of  input  commands. 

5.1.1  Motor  Torques  and  Gimbal  Rates.  It  was  shown  in  section  4.2 
that  both  compensator  designs  were  able  to  meet  required  performance 
specifications  for  both  input  deflections.  In  some  sense,  the  Dahl  controller 
exhibited  much  smoother  response  chacteristics  than  the  Coulomb 
compensator.  There  was  little,  if  any,  overshoot  with  the  Dahl  compensator 
and  very  reasonable  rise  times  were  achieved.  In  fact,  the  rise  times  could 
have  been  reduced  even  further  by  making  the  regulator  poles  faster,  at  the 
cost  of  increasing  the  control  input.  The  Coulomb  controller  had  very  good 
rise  times  due  to  the  very  high  frequency  estimator  poles.  This,  however,  led 
to  considerable  overshoot  problems. 
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The  high  frequency  estimator  poles  in  the  Coulomb  compensator  also 
caused  other  problems  in  terms  of  the  max  torques  and  max  rates.  Figure  5-1 
shows  the  motor  torque  (T^,)  for  a  large  input  deflection  simulation  using  the 
Dahl  controller.  The  max  motor  torque  required  in  this  simulation  was  around 
300  inch-oz.  Figure  5-2  shows  the  motor  torque  for  the  Coulomb  compensator 
for  the  large  deflection  input.  Here  the  max  required  T„j  is 
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Figure  5-1  Motor  Torque  Required  for  Dahl  Compensator 
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Figure  5-2  Motor  Torque  Required  for  Coulomb  Compensator 

much  higher  (around  1.75  x  10"^  inch-oz)  than  that  required  in  the  Dahl 
controller.  The  rates,  0  ,  for  each  compensator  (with  the  large  deflection 
input)  are  plotted  in  Figures  5-3  and  5-4.  The  required  rate  to  meet  the 
performance  specification  with  the  Coulomb  controller  is  much  greater  than 
that  for  the  Dahl  controller.  In  fact,  the  combined  torque  and  rate 
requirements  of  the  Coulomb  compensator  would  most  probably  be 
unachievable.  The  Coulomb  compensator  would  certainly  require  a 
substantially  larger  motor  than  the  Dahl  compensator. 
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Figure  5-3  Gimbal  Rate  for  Dahl  Compensator 
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Figure  5-4  Gimbal  Rate  for  Coulomb  Compensator 
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5.1.2  Noise  and  Robustness.  In  Section  4.2  it  was  shown  that  the 


input  measurement  noise  seemed  to  affect  the  Coulomb  controller  more  so  than 
the  Dahl.  This  was  also  verified  with  other  simulation  runs  that  were  not 
included  for  brevity.  The  Coulomb  compensator  performs  its  position 
regulation  task  adequateley,  but  its  estimate  of  friction  is  very  poor.  This  was 
demonstrated  by  Liebst  (9)  as  well.  Since  the  measurement  noise  is 
differentiated  twice  by  the  estimator  and  the  friction  model  is  too  simplistic, 
poor  friction  estimation  results.  One  way  to  improve  the  performance  of  the 
Coulomb  contoller  might  be  to  measure  acceleration  with  a  low  noise 
accelerometer  and  utilize  it  to  drive  the  estimator  as  well. 

The  measurement  noise  did  not  affect  the  Dahl  compensator  in  the  same 
manner  as  it  did  the  Coulomb  controller.  It  was  expected  from  the  start  of 
this  research  that  the  Dahl  compensator  would  handle  the  noise  better,  since 
the  extended  Kalman  filter  has  a  higher  fidelity  friction  model  to  use  in  its 
estimation,  provided  that  the  weights  Q  and  R  are  set  correctly.  This  brings 
up  a  major  overlying  issue  concerning  the  Dahl  compensator-its  sensitivity  to 
the  weights.  It  is  obvious  from  the  simulation  runs  shown  in  Section  4.2,  and 
from  the  numerous  other  runs  made  using  the  Dahl  compensator,  that  it  can  be 
very  sensitive  to  the  values  used  for  Q  and  R.  It  is  presumed  that,  for  this 
type  of  compensator  to  be  used  in  a  real  system,  a  great  deal  of  design  effort 
must  be  expended  toward  a  good  understanding  of  the  effects  of  the  weights 
on  a  particular  system.  It  is  apparent  that  the  system  might  have  to  be  cycled 
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through  a  pre-mission  start-up  test.  This  was  seen  in  the  large  deflection 
input  case  when  the  system  was  excited  with  an  input  within  the  compliance 
zone  prior  to  seeing  the  large  step.  During  this  start-up  phase,  the  system 
would  be  cycled  through  a  predetermined  commanded  input  to  allow  the  Dahl 
friction  model  parameters  to  converge.  Q  and  R  might  be  varied  to  allow  the 
system  maximum  flexibility  in  input  deflection  magnitudes  or  even  scheduled 
and  used  for  specific  input  deflection  magnitude  ranges.  These  would, 
however,  be  system  design  specific  criteria  that  were  not  addressed  here. 

With  this  in  mind,  a  given  system  ;ould  be  made  to  work  well  with 
measurement  noise  by  changing  the  weights.  In  most  cases  this  may  also 
change  the  performance  of  the  response  characteristics  slightly.  This  was 
shown  in  Figure  4- 13d  and  4-13e.  By  exciting  the  system  within  the  Dahl 
compliance  region  and  changing  the  weights  slightly,  it  appears  that  the 
friction  torque  estimation  is  converging  to  the  actual  value.  Although  the 
position  response  performance  did  not  appear  to  be  degraded,  the  response 
time  of  the  friction  torque  estimation  did  changed  slightly.  It  is  summized 
that  there  are  weighting  values  that  yield  an  optimal  compromise  between  the 
noise  robustness  and  specification  perfomance. 

Both  compensators  were  checked  for  robustness  to  input  deflection 
changes.  Even  though  the  Coulomb  controller  appeared  to  react  well  to  a 
change  in  the  input  magnitude  from  large  to  small,  the  required  motor  torque 
was  approximately  nine  times  that  which  was  required  using  the  small 
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deflection  input  gains.  Hence,  it  is  very  likely  that  some  kind  of  gain 
scheduling  may  be  required  to  allow  for  changes  in  input  deflection 
magnitudes.  The  Dahl  compensator,  on  the  other  hand,  is  very  dependent  on 
the  particular  extended  Kalman  filter  weights  chosen.  As  mentioned  earlier, 
an  actual  system  might  require  some  kind  of  weight  scheduling  scheme  or 
variable  weighting  methodology  to  allow  for  large  changes  in  the  magnitude  of 
the  input  deflection.  The  Dahl  compensator  designs  used  in  these  simulations 
did  not  experience  the  large  increase  in  required  motor  torque  when  changing 
the  magnitude  of  the  input.  This  is  because  the  Dahl  compensator  designs 
used  for  both  large  and  small  input  deflections  had  the  same  regulator  poles. 

5.2  Suggestions  and  Recommendations 

Future  research  in  this  area  should  concentrate  on  issues  concerning  the 
weights  Q  and  R  for  the  extended  Kalman  filter  and  Dahl  friction  model 
controller.  Even  if  this  compensation  method  is  too  complicated  and/or 
requires  an  unrealistic  onboard  computing  capability  for  a  real  system  control 
application,  it  could  still  prove  to  be  valuable  to  bearing  manufacturers.  It 
would  provide  them  with  a  means  to  test  their  bearings  and  measure  the  Dahl 
parameters  o  and  i. 

Walrath  claimed  that  the  Dahl  model  exponential  parameter,  i,  played 
no  significant  role  in  the  model  performance  (3:719-720).  If  this  is  true,  the 
number  of  friction  parameters  that  must  be  estimated  is  reduced  to  just  one,  a. 
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This  would  definitely  make  it  easier  on  the  controller  and  might  give  better 
results.  Investigation  of  Walrath’s  claim  would  have  to  be  carried  out  first. 

Extended  simulations  were  not  run  in  this  research  due  to  the  lengthy 
run  times  required  for  each  simulation.  Although  the  ProMatlab™  macros 
were  very  convenient  and  easy  to  use,  there  might  be  a  more  time  efficient 
method  that  could  be  invoked.  Possible  alternatives  might  include  the  use  of 
MATRIX^  or  direct  Fortran  programming.  This  would  allow  possible  future 
researchers  to  run  the  simulations  longer  and  possibly  receive  more  insight 
into  the  phenomena  that  is  occuring  here. 

A  final  observation  is  one  made  by  Armstrong  (1:51).  To  date,  no 
investigation  has  been  conducted  to  relate  the  micro-morphology  of  the 
contacting  surfaces  to  the  transition  distance  of  the  Dahl  model. 
Understanding  how  the  surface  characteristics  relate  to  the  Dahl  compliance 
region  and  friction  parameters  should  certainly  aid  in  the  design  and 
manufacture  of  bearings,  as  well  as  helping  in  the  development  of  control 
system  application  designs. 
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Appenix  A:  ProMatlab”*  M-Files  for  Coulomb 
Friction  Model  Compensation  for  a  Single  Axis  Servo 


A.l  Coulombl.m 

The  following  ProMatlab™  macro  was  used  in  simulations  of  the  single 
axis  servo  system  used  in  this  research.  This  macro  must  be  given  the 
regulator  and  estimator  gains,  k  and  I,  as  well  as  a  commanded  input,  uc,  and 
the  niose  vector,  v.  It  uses  a  time  step  of  0.01  seconds.  Note  also  that  a  % 
represents  a  non-executable  or  comment  line  in  ProMatlab™. 


%  This  macro  uses  the  basic  system  model  with  coulomb  friction  acting 
%  against  the  motor  torque  u.  0^  is  the  commanded  input,  theta  command. 
%  The  regulator  and  estimator  gains  k  and  I  must  be  calculated  previous 
%  to  using  this  macro,  and  must  be  available  in  the  Mat-file  variable  list. 


% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 

% 


V 


% 

% 

% 

xs=ll; 
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x=[0;0;0;sigma;iij; 

x0=-xinitial;p0=[0  0  0  0  0:0000  0,0  0000.0000  0.0  000  0]; 
n = length  (uc):nn  =  round  (n/]  0};icount = 0;iper=  0; 
ab=fO  1  0;0  0  -l/j:0  0  0]-[0;l/j:0]*k-l*ll  0  0]; 

[acomp,  bcompj = c2d  (ab.  I, .  01); 

xest =[0:0:0]  : 

for  i  =  l:n 

Z=x(l)  +  v(i); 

xs=[x5:x’  xest’  uj: 

icount = icount + /; 

if(icount=  =nn),icount=0:iper=iper+10:is=int2str(iper);. . . 
dispdis,’  %  completed']), end 
DF=x(4)*(l-x(3)/tc*sign(x(2)))"x(5): 
u  =  -k*xest; 

a=[0  1  0  0  0:0  0  -1/j  0  0;0  DF  0  0  0,  0  0  0  0  0,0000  0]: 
b=l0:l/j:0:0:0]: 

[ad,  bd] = c2d(a  ,b,.01); 

x=ad*x-^  bd*u;if(abs  (x{3))>  tc)  ,x(3)=  tc*sign  (x(3)):end 

%  Coulomb  regulator/estimator  compensation  * 

xest = acomp  *xest + bcomp  *  (z-uc(i)): 
end 


A. 2  CoulombZ.m 

The  following  ProMatlab™  macro  was  also  used  for  simulation  of  the 
Coulomb  friction  compensator.  This  version,  howerver,  has  a  time  step  of 
0.001  seconds.  This  was  done  to  allow  the  use  of  very  fast  estimator  poles 
which  would  have  saturated  the  discrete  controller. 


%  This  macro  uses  the  basic  system  model  with  coulomb  friction  acting 
%  against  the  motor  torque  u.  0^  is  the  commanded  input,  theta  command. 
%  The  regulator  and  estimator  gains  k  and  I  must  be  calculated  previous 
%  to  using  this  macro,  and  must  be  available  in  the  Mat-file  variable  list. 

%  This  macro  runs  with  a  discrete  time  step  of  0. 001  seconds  which  means 
%  you  have  to  use  a  large  amount  of  points.  Use  this  version  only  when 
%  you  have  very  fast  estimator  poles  and  you  suspect  that  you  're 
%  exceeding  the  bandwidth  of  the  digitized  controller. 
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% 


% 

% 

% 

% 

% 


% 

% 

% 

% 

% 

% 

% 

% 

% 

% 


0c 


V 


xs=fj; 

x=f0;0;0;signa;iij; 

x0=xinitial:p0=[0  00  0  0;0  0  0  0  0;0  0  0  0  0;0  0  0  0  0,0  0  0  0  OJ; 

n  =  length(uc);nn  =  round(n/10);icount=0;iper—0; 

ab=[0  I  0;0  0  -I/j.  O  0  0J-[0;l/j;0]*k-l*fl  0  OJ; 

facomp.bcompj = c2d  (ab,l, .  01 ); 

xest=l0;0;0l; 

for  i  =  l:n 

z=x(l)  +  v(i); 

xs  =  fxs;x’  xesf’  uj; 

icount  =  icount  +  l; 

if(icount  ==nn),  icount = 0;iper = iper+ 1 0;is = int25tr(iper);. . . 
dispffis,’  %  completed’}), end 
DF = X  (4)*  (I -X  (3)/tc  *sign  (x  (2)))  "x  (5); 
u  =  -k*xest; 

a=[0  1  00  0;0  0  -1/j  0  0;0  DF  0  0  0;0  0  0  0  0,0000  OJ; 

b=l0;l/j,0;0;0J; 

fad,bdj=c2d(a,b,.001); 

x=ad*x+bd*u;if(abs(x(3))>tc),x(3)=tc*sign(x(3));end 

%  Coulomb  regulator/estimator  compensation  * 

xest = acomp  *xest + bcomp  *  (z-uc(i)); 
end 
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Appendix  B:  ProMatlab"*  M-File  Simulating 
Single  Axis  Servo  Using  the  Dahl  Friction  Compensator 


% 

% 

% 


This  is  the  basic  system  model  with  Dahl  friction  acting  against 
the  motor  torque  U.  The  input  uc  is  the  commanded  position. 


% 

% 

% 

% 

% 

% 

% 


% 

% 

% 

% 

% 


% 

xs=[J: 

X = [0;0;0;sigma;iij; 

xO=xinitial;pO=fO  0  0  0  0;0  0  0  0  0;0  0  0  0  0;0  0  0  0  0;0  0  00  OJ; 

n  =  length(uc);nn  =  round(n/10);icount=0;iper-0; 

ksave=fj; 

for  i  =  l:n 

z=x(l)  +  v(i}; 

xs=fxs;x’  xO’  uj; 

icount-=icount  ■¥  1  ; 

if(icount=  =  nn),icount=0;iper=iper+10;is=int2str(iper);. . . 
disp([is,’  %  completed’)), end 
DF=x(4)*(l-x(3)/tc  *sign  (x  (2)))  ^x  (5); 
ua  =  -kk*xO(l  :3)+M*uc(i); 

a=fO  1  0  0  0;0  0  -Uj  0  0;0  DF  0  0  0;0  0  0  0  0,0000  OJ; 

b=[0;l/J,0;0,0]; 

fad,bdj=c2d(a,b,.01); 

x=ad*x-i-bd*ua;if(abs(x(3))  >  tc),x(3)  =tc*sign(x(3));end 
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%  *>t<>K***»******>l>***>K*>K<t<*>t<****>t<*>«iK*>K*i«**lttXc****>|c**Kc**Kc:(c**j|c^Hc******:(c*** 

%  Extended  Kalma.i  Filter  estimation  * 

*>«***i|<*>l<*Ht***it<***#*****iti*i(c*Kc*Kt#iK*i|c****i|ci|ci|c*iK*Kc*i(«*i|t***l|c*itt*lK*lKHc**:(tKe:(t* 

xestk  =xO;pk  =  pO; 

^  *>*********** ************ 

%  setting  up  F=df/dx\x=xest  * 

**************************:flt******** 

qlog  =  l-xestk(3)/tc*sign(xestk(2)); 
dfl=[0;0;0;0;0]; 
dJ2=[l;0:0;0;0]; 
if  (qlog-  =0) 

df2  =  /] ;0;xestk(4)  *  (qlog)'' xestk (5 );0;0J; 
end 

df3=l0;l/j;0;0:0]; 
if  (qlog  -  =0) 

df3 = (0;- 1  /j;xestk(4j  *xestk(5 )  *  (qlog)'' (xestk(5)-l  )*... 

xestk(2)  *  (-1/tc)  *sign  (xestk  (2));0;0J; 

end 

df4  =  l0;0;0;0;0]; 
if  (qlog  -  =0) 

df4  =  [0;0;  (qlog)''xestk(5)  *xestk(2);0;0J; 
end 

df5  =  f0;0:0;0;0]; 
if  (qlog  -  =0) 

df5=[0;0;xestk(4)*(qlog)''xestk(5)*xestk(2)*. . . 

log(qlog);0;0J; 

end 

F=fdfl  df2  df3  df4  df5]; 

^  *************************^,^„„i^:^,^^^^,), 

DFest  =  0; 
if  (qlog  -  =0) 

DFest=xestk(4)*(l-xestk(3)/tc*sign(xestk(2)))"xestk(5); 

end 

pdot  =  F*pk+pk*F’  +  G*Q*G'; 
xestdot=lxestk(2);l/j*(u-xestk(3));DFest*xestk(2);0;0]; 
xestkpluc  =  xestk  +xestdot*delt; 
pkp  luc=pk+pdot  *de!t; 

H=[l  000  0]; 

k=pkpluc*H’*inv(H*pkpluc*H’+r); 
ksave-  [ksa  ve;k  ’]; 

xestcor=xestkpluc+k*(z-xestkpluc(I));if(abs(xestcor(3))  >  tc),.. . 

xestcor(3)=tc*sign(xestcor(3));end 

if(xestcor(4)  <  l),xesicor(4)  =0;end 
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pkcor  =  pkpl  uc-k  *H*pkp  1  uc; 
xO=xestcor;pO  =  pkcor; 

end 

end 
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